function data = transformData2DRigid(state, data)

trans = state(1:2);
theta = state(3);
rot = [cos(theta) -sin(theta);
       sin(theta)  cos(theta)];

data = [rot*data']' + repmat(trans, size(data, 1), 1);
